
Pose target_pose
CartesianTrajectoryConstraint constraint